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The resolved rate (inverse velocity) solution is derived. Given the desired Cartesian 
ritv of the end-effector, the required leg actuator rates are calculated. The Newton- 



rate control. 





1 INTRODUCTION 

In-parallel actuated manipulators are robotic mechanisms with a closed-chain, parallel 
kinematic structure, as opposed to the open-chain, serial kinematic structure of common 
industrial manipulators. Although serial manipulators are more widely applied due in 
part to their anthropomorphic nature, interest in parallel manipulators is growing because 



Stewart platform adaptation is shown in the general kinematic diagram of Fig. 1. This 
device consists of a moving platform and a fixed base, each with six spherical joints. 
Connecting the platform and base are six legs with prismatic joints. The platform of Fig. 
1 theoretically has twelve degrees of freedom, calculated by the Kutzbach equation, Eq. 



, (Mabie and Reinholtz, 1987). In Eq. 1, DOF is the number of degrees of freedom, N is 
. i r i* 2 i iUa l«nl r T is t.he number of t— decree of freedom 
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the axes of each leg. Practical designs of such platforms constrain these six extra freedoms. 
The platform thus has six degrees of freedom which allow general positioning and orienting 

in three dimensions. 

Most current Stewart platform applications are in aircraft simulators and related fields. 



problem for parallel manipulators are cumbersome, when they exist. Analytical solutions 





model uses a one-point iteration method which is a divergence from Nanua, et. al. (1990), 
while the exact model uses a Newton-Raphson method with first order gradient correction. 
An advantage of the latter method is that the Newton-Raphson Jacobian matrix yields 
the platform inverse Jacobian matrix with little modification. Therefore, the resolved rate 
(inverse velocity) solution follows with little additional computation. Static examples are 



given to demonstrate calculations for the equations of this paper. Platform simulations are 
presented to demonstrate translation and'rotation motion. In addition, the simulations 
study the error resulting from the simplified forward kinematics model. 
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hydraulically actuated prismatic joints. The total leg lengths are denoted Li,i 1,2,..., 6. 
The minimum total leg length is 1.524 m(60 in) and the maximum is 2.286 m(90 in). The fixed 
base ball joint locations are B it i = 1,2,..., 6 and the moving platform ball joint locations 
are Pi i = 1,2, ..., 6 . Figures 3a and b show the fixed base and moving platform geometry, 



placement along 



ATICS 



In order to express the moving platform ball joint locations in {£?}, Eq. 4 is used. 



. This problem involves coupled nonlinear equations. No analytical solution 


lutions exist. There are no analytical solutions to 



Section 4. The first method uses a simpler iteration, requiring less computation per cycle. 
The first method has inherent error because the moving platform ball joints are located 
in three pairs instead of the distinct locations in Fig. 2. The theoretical error associated 
with the second method is essentially zero, dependent on the convergence tolerance and 


, et. al. (1990) claim to present the first analytical forward position kinematics 



«3 = |QnQi | 



61 = |BiB a | 

6 2 = IB3B4I 



+ 6 ? - 2L2i-ibiCOsrpi 



where 



DiC{ 4 " D2C2 4 * Aj c i c 2 + D4S132 4 - D b 
E1C2 4 - E2C3 + E3C2C3 4 - E4S2S3 4 - E b 
F{ C3 4 * ^2 C 1 4 * F3C3C1 4 - F4S3S i 4 - ft 


The coefficients for Eqs. 14, 15, and 16 are given below. 

Di = 2JV,[c/?i(O lX - 0 2 x) -+ spi(Oir ~ 0 2 y)| 
D 2 = - 2 iV 2 |cj 82 (Oix - 0 2X ) + »h(Oir ~ 0 2 y)} 
D 2 = - 2 N t N 2 c{Pi ~ h) 




In + In + z ( A1 o - AC o) + z ( x 'o - xc o) = V 



At this point, Nanua, et. al. (1990) apply Bezout’s method (Salmon, 1964) to Eqs. 



using Eqs. 12 and 13. 
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The rotational error is more complicated because algebraic subtraction does not apply 


to rotation matrices. The following difference matrix is used. 




Nguyen, et. al. (1991) present an iterative forward position kinematics solution for a 
eneral platform, shown in Fig. 1. This method is attractive because it yields the exact 



position and orientation structure of this homogeneous transformation matrix is given in 
Eq. 2. There are six unknowns associated with represented as X = {x,y,z,0x,0Y,^z} • 


The Z-Y-X Euler convention (Craig, 1988) is chosen to represent the orientation of 
{P} with respect to {D}, which leads to the following rotation matrix. 





^U r 12 + ^21^*22 + ^3i r 32 



Equation 34 is written for each of the six legs. The form of each equation is identical; 
the components of °V D i abd r V ri change. Equation 34 can also be used for the inverse 






A common method for manipulator control is the resolved rate solution, obtained by 


As mentioned previously, a modified inverse Jacobian matrix is extracted from the 
ton-Raphson method Jacobian, associated with the exact forward position kinematics 



dXi 



The form of Eq. 39 differs from that of the resolved rate solution, Eq. 37, because 



Jacobian matrix, as shown in Eq. 43. This result is intuitive because the inverse velocity 
problem and forward position iteration require the partial derivatives of the functions, Eq. 
34, with respect to the Cartesian position variables, X. 


To calculate the modified inverse Jacobian matrix, each component in all rows i of 





o 

CO 



This section presents static examples to demonstrate computation for the kinematic 
equations of this paper applied to the VES platform. The first examples find [ r T] for the 
minimum, middle, and maximum leg lengths, L MIN = 1.524, L MID = 1-905, and L MAX = 2.286. 
The exact forward position kinematics solution (Section 3.2.2 and Appendix C) is used. 
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From \pT\, the inverse position kinematics solution is found with Eqs. 3 and 4. 



19 iterations. The translational error is E T = 0.067m. The rotation error difference matrix 
is given, extracting 8xe = 6.144°, 9ye — 5.3S7°,6 ZE — 8.829° and thus En = 12.030°. 

' 0.848 -0.419 0.324 0.197* 

.b t ,_ 0.483 0.863 -0.148 0.333 

[ r l,\- _Q2i8 0.282 0.934 1.493 


The exact model (Section 3.2.2 and Appendix C) calculated the following \ D r T\ in 6 
iterations. The translational error is zero, to three decimal places. The rotation error 




CSI 

CN1 



A series of three platform motion simulations is presented in this section. The first is 
a pure straight-line translation, the second is a pure rotational move, and the third is a 
combination of the first two. Smooth trajectory generation is ignored for these kinematic 



position solution errors are reported in Figs. 10c, 11c, and 12c. 
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Table I presents the number of iterations required at each time step for the simplified 



CNJ 








for resolved rate control. 



industrial manipulators have several singularities which degrade overall perlormance. 

Static examples are given to demonstrate calculations of the various equations of this 
paper. Translation and rotation motions are studied in ten second simulations to demon- 
strate the leg inputs, the forward position solution convergence, and the simplified forward 


position model error for the platform under inverse position or resolved rate control 
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Dissertation, Department of Mechanical Engineering, Virginia Polytechnic Institute and 
State University, Blacksburg, VA, 1988. 

Yang, D.C.H, and Lee, T.W., “Feasibility Study of a Platform Type of Robotic Manipulator from a 
Kinematic Viewpoint”, Journal of Mechanisms, Transmissions, and Automation in Design , Vol. 

106, No. 2, June 1984, pp. 191-198. 



ATFORM PARAMETERS 
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Starting from an initial guess for X, Eqs. B.2 are calculated iteratively, updating each x,- 
for subsequent use. The convergence criteria for this method is given in Dahlquist and 
Bjorck (1974, Section 6.9.1). The convergence of this method is linear. 







change between each successive a,Si is sufficiently small. 


where % = 1,2,3 and e is a user-defined tolerance. In practical implementation of this 
a lcmrit.li m. ronvorcence was achieved even for distant initial guesses. 



position kinematic solution, \f.T,\, is calculated using Eqs. 20, 21, 22, 11, 12, and 13 



ON FOR EXACT M 



The above equations are expanded in a Taylor series about the neighborhood of X. 
Neglecting the quadratic and higher terms, a linear system of equations results. The details 



Newton-Raphson method is given in Dahlquist and Bjorck (1974, Section 6.9. 



a quadratic convergence, which yields convergence in less steps than the linear convergence 
of Appendix B. 





given in Eq. C.6. 






of the YES platform Jacobian matrix. 
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Figure 2 
VES Platform 
Kinematic Diagram 




Fixed Base Detail 



Figure 3 
VES Platform 
Ball Joint Geometry 
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Figure 9 

VES Platform Vertical Translation, 
Equal Leg Lengths 
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Figure 10a 

Inverse Position Solution 
VES Translation Simulation 
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Figure 10b 

Resolved Rate Solution 
VES Translation Simulation 




Figure 10c 

Simplified Forward Model Error 
VES Translation Simulation 
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Figure 11a 

Inverse Position Solution 
VES Rotation Simulation 
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Figure 12a 

Inverse Position Solution 
VES Translation/Rotation Simulation 
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Figure 12b 

Resolved Rate Solution 
VES Translation/Rotation Simulation 




Figure 12c 

Simplified Forward Model Error 
VES Translation/Rotation Simulation 
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